close all
clear all

DLE = 16;
STX = 17;
ETX = 18;
file = fopen('Afstanden.txt', 'r');

i=0;
while(1)
    i = i+1;
    line = fscanf(file,'%i %i %i %i %i %i %i\n', 7);
    if isequal(size(line),[7 1]);
        k(i,:) = line;
    else
        break
    end
end

fclose(file);

data = fopen('Afstanden.data', 'w');

for i=1:size(k,1);
    
    hamming = encode(DLE);
    string = sprintf('%i %i %i %i %i %i %i %i', hamming(1,:));
    fwrite(data, bin2dec(string), 'uchar');
    string = sprintf('%i %i %i %i %i %i %i %i', hamming(2,:));
    fwrite(data, bin2dec(string), 'uchar');
    hamming = encode(STX);
    string = sprintf('%i %i %i %i %i %i %i %i', hamming(1,:));
    fwrite(data, bin2dec(string), 'uchar');
    string = sprintf('%i %i %i %i %i %i %i %i', hamming(2,:));
    fwrite(data, bin2dec(string), 'uchar');
    
    for j=1:size(k,2);
        if(k(i,j)==DLE)
            hamming = encode(DLE);
            string = sprintf('%i %i %i %i %i %i %i %i', hamming(1,:));
            fwrite(data, bin2dec(string), 'uchar');
            string = sprintf('%i %i %i %i %i %i %i %i', hamming(2,:));
            fwrite(data, bin2dec(string), 'uchar');
        end
        hamming = encode(k(i,j));
        string = sprintf('%i %i %i %i %i %i %i %i', hamming(1,:));
        fwrite(data, bin2dec(string), 'uchar');
        string = sprintf('%i %i %i %i %i %i %i %i', hamming(2,:));
        fwrite(data, bin2dec(string), 'uchar');
    end
    
    hamming = encode(DLE);
    string = sprintf('%i %i %i %i %i %i %i %i', hamming(1,:));
    fwrite(data, bin2dec(string), 'uchar');
    string = sprintf('%i %i %i %i %i %i %i %i', hamming(2,:));
    fwrite(data, bin2dec(string), 'uchar');
    hamming = encode(ETX);
    string = sprintf('%i %i %i %i %i %i %i %i', hamming(1,:));
    fwrite(data, bin2dec(string), 'uchar');
    string = sprintf('%i %i %i %i %i %i %i %i', hamming(2,:));
    fwrite(data, bin2dec(string), 'uchar');
    
end

fclose(data);